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Verfahren zur Bestimmung der Lage eines Objekts im Raum 

Die Erfindung betrifft ein Verfahren zur Bestimmung der Lage eines Objekts im 
Raum, bei dem Messmerkmale des Objekts mit einer auf ein Raum- 
Koordinatensystem kalibrierten optischen Aufnahmeeinrichtung aufgenommen 
werden und anhand dieser Messmerkmale in einer Bildverarbeitungseinrichtung 
die Lage des Objekts in dem Raum-Koordinatensystem bestimmt wird. Derartige 
Verfahren finden bspw. bei Produktions- und Montagevorgangen in automati- 
sierten Produktionsstraften Anwendung, bei denen mittels Handhabungsgeraten 
ein Arbeitsvorgang an einem Fertigungsobjekt unbekannter Lage durchgefuhrt 
werden soli. 

In der EP 0 911 603 B1 ist zur optischen Bestimmung der Lage eines starren 
Korpers in einem raumlichen Koordinatensystem beschrieben, jede aus einer 
Auswahl von mindestens drei auf dem starren Korper vorhandenen Linien oder 
Kanten, deren Bezug zum korpereigenen Koordinatensystem bekannt ist, in ei- 
nem ebenen Koordinatensystem abzubilden, wobei die Lage der ebenen Koor- 
dinaten auf das raumliche Koordinatensystem bezogen ist und auf eine Zuord- 
nung ausgezeichneter Punkte verzichtet wird. Die Kanten oder Linien werden in 
der Regel durch mehrere Kameras erfasst, wobei es auch moglich ist, eine in 
Bezug auf das raumliche Koordinatensystem kontrolliert bewegbare Kamera 
heranzuziehen und nacheinander mehrere Aufnahmen der Linien oder Kanten 
zu machen. 

Dabei besteht jedoch der Nachteil, dass entweder mehrere Kameras eingesetzt 
und gesondert kalibriert werden miissen oder die Bestimmung der Lage des Ob- 
jekts im Raum lange dauert, weil mehrere Bilder aus unterschiedlichen Positio- 
nen aufgenommen werden miissen. 
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Aufgabe der vorliegenden Erfindung ist es daher, eine Moglichkeit zur Bestim- 
mung der Lage eines Korpers im Raum vorzuschlagen, die eine zuverlassige 
Ermittlung der Lage eines Objekts im Raum mit weniger Kameras oder Kamera- 
positionen zulasst. 

Diese Aufgabe wird bei einem Verfahren der eingangs genannten Art im We- 
sentlichen mit den Merkmalen des Anspruchs 1 gelost. Dazu werden mindes- 
tens zwei Messmerkmale des Objekts in einer Aufnahmeeinrichtung gleichzert.g 
erfasst und zur Bestimmung der Lage des Objekts herangezogen. Hierzu wer- 
den die Messmerkmale, deren Koordinaten in ihrem eigenen Koordinatensys- 
tem, insbesondere einem Objekt-Koordinatensystem, bekannt sind bzw. durch 
die Bildverarbeitung ermittelt werden konnen, in einem zweidimensionalen Ko- 
ordinatensystem der Aufnahmeeinrichtung abgebildet. Da die durch die Position 
und Ausrichtung bestimmte Lage der Aufnahmeeinrichtung im Raum-Koord.- 
natensystem und deren Abbildungseigenschaften bekannt ist, kann die Bildver- 
arbeitung uber an sich bekannte Auswerteverfahren eine Relation zwischen den 
in dem zweidimensionalen Koordinatensystem der Aufnahmeeinrichtung abge- 
bildeten Messmerkmalen und dem Raum-Koordinatensystem herstellen. Uber 
den bekannten Bezug der verschiedenen Messmerkmale zueinander in dem 
Objekt-Koordinatensystem kann dann auf die Anordnung der aufgenommenen 
Messmerkmale im Raum ruckgeschlossen werden. Dies lasst eine Lagebestim- 
mung des Objekts im Raum zu. Dabei konnen erfindungsgemalJ auch Mess- 
merkmale zu mehreren Gruppen zusammengefasst und in verschiedenen Teil- 
messungen erfasst werden, wobei die Koordinaten der Messmerkmale in e.ner 
Gruppe relativ zueinander bekannt sind, ohne dass die Koordinaten relativ zu 
Messmerkmalen anderer Gruppen ebenfalls bekannt sind. Durch Zusammen- 
fassung der verschiedenen Teilmessungen konnen die Koordinaten des Ge- 
samtkorpers mit erhohter Genauigkeit bestimmt werden. 
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Bisher wurde angenommen, dass die optischen Achsen der Messeinrichtungen, 
mit denen die verschiedenen Messmerkmale zur Lagebestimmung aufgenom- 
men wurden, im Raum unterschiedlich ausgerichtet sein mussen, urn mathema- 
tisch stabile Losungen der Auswertealgorithmen erreichen zu konnen. Dies hat 
es erforderlich gemacht, jedes Messmerkmal, das zur Bestimmung der Lage 
des Objekts im Raum herangezogen wurde, aus einer anderen Kameraposition 
aufzunehmen. Dies wurde entweder durch eine Vielzahl von Kameras erreicht, 
die an verschiedenen Orten aufgebaut und jeweils kalibriert sind, und hatte ei- 
nen entsprechend grofcen apparativen Aufwand zur Folge. Alternativ konnte die 
Kamera auch nacheinander kontrolliert in verschiedene Aufnahmepositionen 
bewegt werden. Dies fuhrte jedoch zu einer vergleichsweise langsamen Lage- 
bestimmung, da alle Bilder nacheinander ausgewertet werden mussten. Mit der 
vorliegenden Erfindung hat sich nun herausgestellt, dass es moglich ist, mehre- 
re Messmerkmale mit einer Kamera gleichzeitig zu erfassen und fiir die Lagebe- 
stimmung im Raum heranzuziehen. Dadurch wird die Geschwindigkeit bei der 
Bestimmung der Lage eines Objekts im Raum erheblich beschleunigt. Beson- 
ders vorteilhaft ist es dafur, wenn die verschiedenen, in einer Kamera erfassten 
Messmerkmale auf dem Objekt einen deutlichen, insbesondere moglichst gro- 
Ren Abstand aufweisen. Die erreichbare Genauigkeit hangt insbesondere von 
dem Abstand der Messmerkmale auf dem Objekt ab. Je nach gewunschter Ge- 
nauigkeit kann daher ein bestimmter Abstand als Mindestabstand zwischen zwei 
Messmerkmalen vorgegeben werden. Bei geringeren Anforderungen an die Ge- 
nauigkeit kann das erfindungsgemafce Verfahren jedoch auch mit dicht neben- 
einander liegenden Messmerkmalen durchgefuhrt werden. 

Urn die Lage eines Objekts im Raum, d. h. dessen Position und Orientierung, 
genau ermitteln zu konnen, mussen alle sechs Freiheitsgrade des Objekts be- 
stimmt werden. Dies kann erfindungsgemafc durch Auswertung von mindestens 
drei Merkmalen aus mindestens einem aufgenommenen Bild erreicht werden. 
Die Bestimmung einer Objektposition und -orientierung ist also durch Auswer- 
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tung von drei Messmerkmalen moglich, die in einer oder in mehreren Aufnah- 
men identifizierbar sind. Besonders vorteilhaft ist es dabei, wenn alle zur Aus- 
wertung benotigten Messmerkmale mit einer Aufnahme erfasst werden. Es ist 
jedoch erfindungsgemafi auch moglich, bspw. eines der drei benotigten Mess- 
merkmale mit einer zweiten Aufnahmeeinrichtung oder einer zweiten Aufnah- 
meposition der einen Aufnahmeeinrichtung zu erfassen. Durch die Zusammen- 
fassung von mindestens zwei Merkmalen in einer Aufnahmeeinrichtung wird be- 
reits eine erhebliche Verbesserung im Hinblick auf den apparativen Aufwand 
und/oder die Auswertegeschwindigkeit erreicht. 

Mit nur drei Messmerkmalen kann jedoch kein Restfehler bestimmt werden. Bei 
Verwendung von vier oder mehr Messmerkmalen ist zusatzlich die Bestimmung 
eines Restfehlers nach einer Fehlerausgleichsrechnung moglich. Der Restfehler 
charakterisiert den Fehler zwischen der modellierten Geometrie und der Realitat 
und ist daher ein Mali fur die erreichte Genauigkeit. ErfindungsgemaB ist es je- 
doch vorteilhaft, nicht mehr als funf Messmerkmale gleichzeitig mit einer Aus- 
werteeinrichtung zu erfassen. Auch wenn der Restfehler mit der Anzahl der 
Messmerkmale abnimmt, hat es sich herausgestellt, dass eine Auswertung von 
mehr als funf Messmerkmalen in einem Bild bei den bekannten Auswertemetho- 
den nicht mehr zu einer signifikanten Verbesserung des Fehlers fuhrt. Daher 
kann zur Vermeidung unnotiger Auswertearbeit auf eine groliere Anzahl von 
auszuwertenden Messmerkmalen in einem Bild einer Auswerteeinrichtung ver- 

zichtet werden. 

Je nach Anwendungsfall ist es moglich bzw. ausreichend, die Bestimmung der 
Lage des Objektes mit weniger als sechs Freiheitsgraden durchzufuhren. Dabe. 
sind beliebige Untermengen moglich. Bei einem zwei- oder eindimensionalen 
Messergebnis kann die Anzahl der notwendigen Messmerkmale aufgrund der 
reduzierten Freiheitsgrade auf zwei bzw. eins verringert werden. Prinzipiell ist 
die Bestimmung der Lage des Objektes in sechs bis ein Freiheitsgraden mog- 
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lich. Die Bestimmung von funf und sechs Freiheitsgraden wird durch mindestens 
drei Messmerkmale, die Bestimmung von drei und vier Freiheitsgraden durch 
mindestens zwei Messmerkmale und die Bestimmung von einem und zwei Frei- 
heitsgraden durch mindestens ein Messmerkmal mdglich. Auch die Erfassung 
von nur einem Messmerkmal in einer Aufnahmeeinrichtung kann mit einem er- 
findungsgemafien Aufnahme- und Auswertesystem durchgefuhrt werden, das 
zur Durchfuhrung des erfindungsgemalJen Verfahrens eingerichtet ist. 

Gemali einer Ausgestaltung des erfindungsgemaUen Verfahrens handelt es sich 
bei den Messmerkmalen insbesondere urn ausgezeichnete Punkte, d. h. punkt- 
formige Merkmale, die selbst keine Orientierung im Raum aufweisen. Eine sol- 
che Orientierung der Messmerkmale im Raum ist fur die Anwendung des erfin- 
dungsgemafcen Verfahrens im Gegensatz zu vielen aus dem Stand der Technik 
bekannten Methoden nicht notwendig und bietet im Vergleich zu Kanten bspw. 
den Vorteil, dass die Position eines ausgezeichneten Punktes im Raum immer 
eindeutig ist. Bei einer Kante oder einer anderen geometrischen Kontur ist da- 
gegen zunachst nicht bekannt, welcher Punkt der Kante genau erfasst ist. Das 
erfindungsgemalie Verfahren lasst sich jedoch auch bei Messmerkmalen an- 
wenden, die als Kanten (mathematische Kurven, Geraden) oder sonstigen be- 
schreibbaren geometrischen Formen ausgebildet sind, wobei sich in diesem Fall 
der Auswerteaufwand erhoht. Bei einer Kante kann der Winkel der Kante im 
Raum als zusatzliche Randbedingung verwendet werden, urn die Robustheit 
und Stabilitat des mathematischen Losungsmodells zu erhohen. Das Verfahren 
lasst sich erfindungsgemaii auch bei einer Konturauswertung mit beliebig vielen 
Punkten anwenden. 

Obwohl das Verfahren gut mit einer einzigen Aufnahmeeinrichtung ausgefuhrt 
werden kann, konnen erfindungsgemali auch mehrere Aufnahmeeinrichtungen 
verwendet werden. Die Anzahl sowie die Anordnung der an der Messung betei- 
ligten Aufnahmeeinrichtungen kann dabei von der Ausdehnung und Geometrie 
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des zu messenden Objekts sowie der erforderlichen Genauigkeit des Messer- 
gebnisses abhangig gemacht werden. 

Gemaft einer vorteilhaften Ausgestaltung kann ein Messmerkmal auch in meh- 
reren Aufnahmeeinrichtungen abgebildet werden. Damit erhoht sich im Allge- 
meinen die Genauigkeit des Gesamtergebnisses urn den Beitrag dieses Mess- 
merkmals, weil hierdurch eine nicht unbedingt notwendige Uberbestimmung er- 
reicht und zur Erhohung der Genauigkeit ausgenutzt wird. 

Urn eine hohe Flexibility zu erhalten, konnen erfindungsgemali eine oder meh- 
rere stationare und/oder insbesondere mittels eines Handhabungsgerates be- 
wegbare Aufnahmeeinrichtungen verwendet werden. Dabei konnen sich an ei- 
nem Handhabungsgerat auch mehrere fest miteinander verbundene Kameras 
befinden. Durch den Einsatz eines Handhabungsgerates ist es auch moglich, 
eine Aufnahmeeinrichtung nacheinander an verschiedene Messpositionen zu 
bringen und dort Bilder aufzunehmen. Bei diesen bewegten Handhabungsein- 
richtungen muss das Handhabungsgerat entweder immer die gleichen Raumpo- 
sitionen anfahren, an denen die Aufnahmen stattfinden, oder die kalibrierten 
Koordinaten seiner eigenen Raumposition ermitteln konnen und an die Bildver- 
arbeitung ubergeben. 

Dies kann bspw. durch eine dreidimensionale Kalibrierung der Aufnahmeeinrich- 
tung an dem Handhabungsgerat erfolgen, so dass aufgrund der kontrollierten 
Bewegung des Handhabungsgerates die Lage der Aufnahmeeinrichtung an dem 
Handhabungsgerat in jedem erreichbaren Bewegungszustand bekannt ist. Es ist 
auch moglich, die Lage der Aufnahmeeinrichtung selbsttatig durch Vermessen 
von Merkmalen mit bekannten Koordinaten und/oder durch den Einsatz externer 
Messmittel zu bestimmen. Insbesondere ist es denkbar, die bewegten Aufnah- 
meeinrichtungen aufcerhalb des eigentlichen Messraumes, an dem die Lage des 
Objektes zu bestimmen ist, zu kalibrieren, indem ein Kalibriermedium aufierhalb 
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dieses Messraumes angebracht ist. Dazu kann die zu kalibrierende Aufnahme- 
einrichtung durch das Handhabungsgerat so bewegt werden, dass das Kalib- 
riermedium durch die Aufnahmeeinrichtung abgebildet wird. Aus der bekannten 
Lage des Kalibiermediums Iasst sich dann die Lage der Aufnahmeeinrichtung 
ermitteln und deren Kalibrierung durchfiihren. Dies hat den Vorteil, dass das zu 
vermessende Objekt vor der Kalibrierung nicht demontiert werden muss. Durch 
die vorbeschriebenen besonders vorteilhaften Kalibriermoglichkeiten wird er- 
reicht, dass fur eine bewegbare Aufnahmeeinrichtung nach einer Bewegung des 
Handhabungsgerates die Lage des Aufnahmeeinrichtung in dem Raum- 
Koordinatensystem bestimmt wird. Das erfindungsgemalie Verfahren ist jedoch 
von der Kalibriermethode unabhangig und kann mit beliebigen Kalibrierungen 
eingesetzt werden. 

Gemall einer vorteilhaften erfindungsgemalien Variante wird die Aufnahmeein- 
richtung derail positioniert, dass zwischen in die Aufnahmeeinrichtung fallenden 
Sehstrahlen, welche von verschiedenen Messmerkmalen ausgehen und zur Be- 
stimmung der Lage des Objekts herangezogen werden, jeweils ein grolier Zwi- 
schenwinkel besteht. Ein erfindungsgemalJ grolier Zwischenwinkel ist dann ge- 
geben, wenn die von verschiedenen Messmerkmalen ausgehenden Sehstrahlen 
nicht parallel oder im Wesentlichen parallel verlaufen. Vorzugsweise ist die Auf- 
nahmeeinrichtung so positioniert, dass die oder moglichst viele Zwischenwinkel 
grolier als etwa 10° sind. Dies stellt keine scharfe Grenze dar, da die GroRe des 
Zwischenwinkels die Genauigkeit des Ergebnisses bestimmt. Bei entsprechend 
geringeren Genauigkeitsanforderungen konnen daher auch kleinere Winkel von 
bspw. 5° bis 6° ausreichen. Dies gilt insbesondere dann, wenn nur wenige, 
bspw. ein oder zwei Zwischenwinkel, kleiner sind als die bevorzugten Zwi- 
schenwinkel von grader etwa 8° bis 10°. Entsprechende Winkelbegrenzungen 
gelten bei der Annaherung der Zwischenwinkel an 180°. In diesem Fall Iasst 
sich immer noch eine ausreichende Genauigkeit erreichen. Es hat sich erfin- 
dungsgemafi herausgestellt, dass es moglich ist, mehrere Messmerkmale mit 
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einer Kamera zu erfassen und mit ausreichender Genauigkeit auszuwerten, 
wenn insbesondere die Winkel zwischen den einzelnen, von diesen Messmerk- 
malen ausgehenden Sehstrahlen ausreichend grofi sind. Dann verlaufen die 
verschiedenen Sehstrahlen nicht parallel bzw. nicht im Wesentlichen parallel. 
Die erreichbare Genauigkeit bei der Positionsbestimmung wird dabei um so ho- 
her, je grolier die Zwischenwinkel zwischen den Sehstrahlen sind. 

Dies gilt erfindungsgemafi auch fur den Fall, dass jeweils nur ein Messmerkmal 
in der einer Aufnahmeeinrichtung erfasst wird, wobei insgesamt mehrere Auf- 
nahmepositionen verwendet werden (mehrere Aufnahmeeinrichtungen oder 
mehrere Positionen einer Aufnahmeeinrichtung nacheinander). Auch in diesem 
Fall ist die Ausrichtung der optischen Achsen der Aufnahmeeinrichtung(en) an 
den Aufnahmepositionen nicht entscheidend, solange die von den zur Auswer- 
tung herangezogenen Sehstrahlen verschiedener Messmerkmale ausreichend 
grofie Zwischenwinkel aufweisen. Daher ist ein eigenstandiger Aspekt der vor- 
liegenden Erfindung darauf ausgerichtet, ein Verfahren zur Bestimmung der La- 
ge eines Objekts im Raum vorzuschlagen, bei dem Messmerkmale des Objekts 
mit mindestens einer auf ein Raum-Koordinatensystem kalibrierten optischen 
Aufnahmeeinrichtung aufgenommen werden und anhand dieser Messmerkmale 
in einer Bildverarbeitungseinrichtung die Lage des Objekts in dem Raum- 
Koordinatensystem bestimmt wird. Dabei wird die Aufnahmeeinrichtung derart 
positioniert, dass zwischen in die eine oder die mehreren Aufnahmeinrich- 
tung(en) fallenden Sehstrahlen, welche von verschiedenen Messmerkmalen 
ausgehen und zur Bestimmung der Lage des Objekts herangezogen werden, 
jeweils ein grofler Zwischenwinkel besteht. 

In der Praxis werden in der Regel ausreichende Genauigkeiten bei der Lagebe- 
stimmung erreicht, wenn die Zwischenwinkel zwischen den Sehstrahlen insbe- 
sondere in einem Bereich von etwa 10° und 170° liegen. Je nach Anwendungs- 
fall kann jedoch auch ein grofterer oder kleinerer Winkelbereich sinnvoll sein. 
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Eine optimale Genauigkeit wird erreicht, wenn die Aufnahmeeinrichtung je nach 
Anwendungsfall derart positioniert und/oder eingerichtet wird, dass jeweils ein 
moglichst grofcer Zwischenwinkel besteht. Dies kann bspw. durch eine Abstim- 
mung von Aufnahmeentfernung und Brennweite des Objektivs der Aufnahme- 
einrichtung erreicht werden. Zur Erzielung moglichst grofcer Winkel zwischen 
den Sehstrahlen ist der Einsatz von insbesondere kurzbrennweitigen Objektiven 
mit grolien Offnungswinkeln forderlich. Bei solchen Weitwinkelobjektiven sind 
die Variationen von Skalierungsanderungen und projektiven Verzeichnungen 
der Objektabbildung in der Aufnahmeeinrichtung, welche bspw. durch eine Ka- 
mera mit einem CCD-Sensor gebildet wird, in Abhangigkeit der Objektlage und 
Orientierung grofc, wodurch die Messgenauigkeit verbessert wird. Dabei wird die 
Aufnahmeeinrichtung vorzugsweise so nah an dem Objekt positioniert, dass die 
zur Positionsbestimmung heranzuziehenden Messmerkmale gerade noch von 
der Aufnahmeeinrichtung erfasst werden. Dann wird die von der Aufnahmeein- 
richtung angebotene sensitive Flache, bspw. ein CCD-Chip, optimal ausgenutzt. 

Entscheidend fur die Anwendung des erfindungsgemafcen Verfahrens ist es, 
dass die Koordinaten der Messmerkmale in dem zu vermessenden Objekt zu- 
geordneten Koordinaten, d. h. in den Objekt-Koordinatensystem, fur die Bild- 
auswertung bekannt sind und/oder durch diese ermittelt werden konnen. Dies 
kann erfindungsgemafi dadurch erreicht werden, dass die Objektdaten mit den 
Koordinaten der Messmerkmalen der Bildverarbeitung bspw. in Form von Kon- 
struktionsdaten vorgegeben werden. Entsprechend einer weiteren Ausfuhrungs- 
form der vorliegenden Erfindung ist es auch moglich, die Koordinaten der 
Messmerkmale auf den Objekten zu erlernen. Dazu wird das Objekt in mehreren 
bekannten Lagen durch die Aufnahmeeinrichtung aufgenommen. Die aufge- 
nommenen Bilder werden dann entsprechend ausgewertet und die Koordinaten 
den jeweiligen Messmerkmalen zugeordnet. Dabei kann die Bildverarbeitung 
bspw. alle moglichen, auf dem Objekt zur Verfugung stehenden Messmerkmale 
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erfassen, so dass fur die Bestimmung der Lage des Objektes im Raum eine 
Vielzahl verschiedener Messmerkmale zur Verfugung stehen. 

Gemati einer Weiterentwicklung des erfindungsgemalien Verfahrens werden die 
Auswahl der von einer Aufnahmeeinrichtung zu erfassenden Messmerkmale, die 
Position der Aufnahmeeinrichtung und/oder die Brennweite der Aufnahmeein- 
richtung selbsttatig bestimmt. Dies bietet sich insbesondere bei bewegbaren 
Aufnahmeeinrichtungen an, da bei diesen der aufzunehmende Bildausschnitt 
des Objektes so ausgewahlt werden kann, dass signifikante, fur die Lagebe- 
stimmung des Objektes besonders geeignete Messmerkmale den sensitiven 
Bereich der Aufnahmeeinrichtung optimal abdecken. Dazu kann die Aufnahme- 
einrichtung bspw. ein Testbild des Objektes machen. Die Bildverarbeitung iden- 
tifiziert in diesem Testbild die erkennbaren Messmerkmale. Durch Uberprufung 
verschiedener Aufnahmepositionen und/oder verschiedener fur die Auswertung 
verwendeter Messmerkmale kann dann automatisch die optimale Aufnahmepo- 
sition ermittelt werden. Ggf. kann zusatzlich auch die Brennweite des Objektives 
der Aufnahmeeinrichtung angepasst werden, sofern die Brennweite bei der Auf- 
nahmeeinrichtung automatisch einstellbar ist. 

Weitere Vorteile, Merkmale und Anwendungsmoglichkeiten der vortiegenden 
Erfindung ergeben sich auch aus der nachfolgenden Beschreibung von Ausfuh- 
rungsbeispielen und der Zeichnung. Dabei bilden alle beschriebenen und/oder 
bildlich dargestellten Merkmale den Gegenstand der Erfindung, unabhangig von 
ihrer Zusammenfassung in den Anspruchen und/oder deren Ruckbezugen. 


Es zeigen: 


Fig. 1 schematisch die Bestimmung der Objektlage in einem Raum 

Koordinatensystem mit einer stationaren Aufnahmeeinrichtung; 
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Fig. 2 schematisch die Bestimmung der Objektlage in einem Raum- 

Koordinatensystem mit einer bewegten Kamera und 

Fig. 3 schematisch die Bestimmung der Objektlage in einem Raum- 

Koordinatensystem relativ zu einer Nulllage des Objekts. 

In Fig. 1 ist ein erfindungsgemalies System dargestellt, mit dem das Verfahren 
zur Bestimmung Lage eines Objekts 1 im Raum gemafi, der vorliegenden Erfin- 
dung durchgefuhrt werden kann. Dieses zeigt ein Objekt 1, dessen Lage im 
Raum bestimmt werden soli. Diese Anforderung besteht haufig bei Produktions- 
und Montagevorgangen in automatisierten Produktionsstralien, bei denen das 
Objekt 1 bspw. durch ein Forderband oder dgl. im Raum positioniert wird. Die 
Lage des Objektes 1 ist dann unbekannt. Ziel der Lagebestimmung ist es zu- 
meist, einen Montage-, Greif- oder Bearbeitungsvorgang an einem Fertigungs- 
objekt 1 in unbekannter Lage durchfuhren zu konnen. Eine Montage muss dabei 
in der Regel immer an einem gleichen Bezugspunkt auf dem Objekt 1 stattfln- 
den. Urn dies zu erreichen, muss bei unbekannter Lage des Objektes 1 diese 
gemessen und ein Handhabungsgerat 2, welches das zu montierende Tell an 
dem Objekt 1 anbringen soli, entsprechend dem Messergebnis nachgefuhrt 
werden. Die an dem Objekt 1 durchzufuhrenden Aufgaben reichen u.a. vom An- 
bringen von Komponenten, beispielsweise Einsetzen einer Tur in eine Karosse, 
oder dem gezielten Aufbringen von Material, beispielsweise Klebstoffe oder 
Dichtungsmaterial auf einem Objekt 1 , bis hin zum Durchfuhren von Montage- 
bewegungen an dem Objekt, beispielsweise Verschraubung von Verbindungen, 
Verschweiften mechanisch vorpositionierter Teilobjekte oder dgl.. Ferner kann 
es beabsichtigt sein, das Objekt zu greifen, urn es zu bewegen. Die Anwendung 
des erfindungsgemaden Verfahrens ist jedoch nicht auf diese Anwendungsfalle 
beschrankt, sondern kann allgemein bei der Lagebestimmung eines beliebigen 
Korpers im Raum Verwendung finden. 
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Zur Bestimmung der Lage des Objektes 1 im Raum wird das Objekt 1 mit einer 
Aufnahmeeinrichtung 3, beispielsweise einer optischen Kamera mit einem CCD- 
Sensor, aufgenommen. Dabei wird das Objekt 1 mit Messmerkmalen 4 abgebil- 
det, die fur die Auswertung der Lage des Objektes 1 im Raum herangezogen 
werden. Bei diesen Messmerkmalen 4 kann es sich urn ausgezeichnete Punkte 
handeln, d.h. punktfdrmige Merkmale, die im Raum keine Orientierung aufwei- 
sen. Ferner konnen geometrische Formen, wie Kreise, Striche, der Schwerpunkt 
eines besonders gekennzeichneten Gebietes, Objektecken oder -kanten oder 
sonstige Merkmale herangezogen werden, die in dem von der Aufnahmeeinrich- 
tung 3 aufgenommenen Bild eindeutig identifiziert werden konnen. Wenn die 
Lage des Objektes 1 im Raum in sechs Freiheitsgraden, d.h. im Hinblick auf Po- 
sition und Orientierung, unbekannt ist, werden mindestens drei Messmerkmale 4 
zur Auswertung herangezogen, die auf dem Objekt voneinander beabstandet 
sind und in der einen Aufnahmeeinrichtung 3 erfasst werden. Prinzipiell ist es 
jedoch auch moglich, mehrere Aufnahmeeinrichtungen 3 vorzusehen. 

Durch die Aufnahme der Messmerkmale 4 des Objektes 1 wird in der Aufnah- 
meeinrichtung 3 ein zweidimensionales Abbild des Objektes 1 mit den Mess- 
merkmalen 4 erzeugt. In einer an die Aufnahmeeinrichtung 3 angeschlossenen, 
nicht gesondert dargestellten Bildverarbeitungseinrichtung wird das aufgenom- 
mene Bild dann verarbeitet. Aufgrund der dreidimensionalen Kalibrierung der 
Aufnahmeeinrichtung 3 in dem Raum-Koordinatensystem 5, bei dem es sich 
insbesondere urn das Weltbezugs-Koordinatensystem handelt, und der bekann- 
ten Abbildungseigenschaften der Aufnahmeeinrichtung 3 konnen den Mess- 
merkmalen 4 des Objektes 1 definierte Raumpunkte zugewiesen werden. Da 
gleichzeitig die Koordinaten der Messmerkmale 4 relativ zueinander in dem Ob- 
jekt-Koordinatensystem 6 bekannt sind, lasst sich die Lage des Objektes 1 so- 
wohl im Hinblick auf die Position als auch die Orientierung im Raum genau er- 
mitteln. 
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Diese Informationen konnen verwendet werden, urn das Handhabungsgerat 2 
so zu steuern, dass das Objekt 1 beispielsweise an eine vorbestimmte Raum- 
position bewegt wird oder an dem Handhabungsgerat 2 befindliche Montagege- 
genstande positionsgenau an dem Objekt 1 angebracht werden. 

Eine hohe Genauigkeit lasst sich trotz der Auswertung von mehreren Mess- 
merkmalen 4 in einer Aufnahmeeinrichtung 3 dann erreichen, wenn die ausge- 
werteten Messmerkmale 4 auf dem Objekt 1 weit genug auseinanderliegen. In 
diesem Fall sind auch die Zwischenwinkel zwischen von den einzelnen Mess- 
merkmalen 4 in die Aufnahmeeinrichtung einfallenden Sehstrahlen 7 ausrei- 
chend grofc, so dass die mathematischen Auswertealgorithmen ein stabiles Po- 
sitionsergebnis liefern. Dabei wird die Position der Aufnahmeeinrichtung 3 vor- 
zugsweise so gewahlt, dass moglichst viele Sehstrahlen 7 zu fur die Auswertung 
herangezogenen Messmerkmalen 4 einen moglichst grolien Zwischenwinkel 
aufweisen. Vorteilhaft ist es, wenn der Zwischenwinkel zwischen Sehstrahlen 7 
zu moglichst vielen Messmerkmalen jeweils grolier als etwa 10° ist. 

Fig. 2 zeigt ein vergleichbares System zur Durchfiihrung des erfindungsgema- 
ften Verfahrens, bei dem die Aufnahmeeinrichtung 3 selbst an einem Handha- 
bungsgerat 8 angebracht ist. In diesem Fall werden in einer ersten Aufnahme- 
position der Aufnahmeeinrichtung 3, welche mit durchgezogenen Strichen dar- 
gestellt ist, ein Teil der fur die Auswertung herangezogenen Messmerkmale 4 
erfasst. Danach wird die Aufnahmeeinrichtung 3 in eine zweite Aufnahmepositi- 
on uberfiihrt, welche mit gestrichelten Linien dargestellt ist. In dieser zweiten 
Aufnahmeposition werden weitere Messmerkmale 4 aufgenommen, die fur die 
Auswertung der Lage des Objektes 1 im Raum herangezogen werden. 

Das erfindungsgemaRe Verfahren kann, wie in Fig. 3 dargestellt, auch verwen- 
det werden, urn die Relativverschiebung 9 eines Objektes 1 im Raum zu erfas- 
sen. Das angewendete Prinzip ist dabei dasselbe, wie in den zuvor beschriebe- 
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nen Verfahrensvarianten. Durch eine Aufnahmeeinrichtung 3 werden verschie- 
dene Messmerkmale 4 des Objektes 1 in den verschiedenen Raumpositionen 
erfasst und mittels einer nicht gesondert dargestellten Bildauswertereinrichtung 
ausgewertet. Durch Vergleich der verschiedenen Lagen des Objektes 1 im 
Raum zu verschiedenen Zeitpunkten kann dann die Lage des Korpers relativ zu 
einer Nulllage ermittelt werden. 

Der Vorteil des erfindungsgemalien Verfahrens liegt insbesondere darin, dass 
mehrere Messmerkmale 4, vorzugsweise bis zu funf Messmerkmale 4, gleich- 
zeitig in einer Auswerteeinrichtung erfasst und ausgewertet werden konnen. 
Dies vereinfacht und beschleunigt die Bestimmung der Objektlage im Raum im 
Vergleich zu bisher bekannten Verfahren erheblich. 


3. Februar 2004 


I 48 P 46 


-15- KEIL & SCHAAPHAUSENf 

PATENTANWALTE 


Bezugszeichenliste: 

1 Objekt 

2 Handhabungsgerat 

3 Aufnahmeeinrichtung 

4 Messmerkmal 

5 Raum-Koordinatensystem 

6 Objekt-Koordinatensystem 

7 Sehstrahlen 

8 Handhabungsgerat 

9 Relatiwerschiebung 
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Patentanspruche: 


1 Verfahren zur Bestimmung der Lage eines Objekts im Raum (1), bei dem 
Messmerkmale (4) des Objekts (1) mit einer auf ein Raum-Koordinatensystem 
(5) kalibrierten optischen Aufnahmeeinrichtung (3) aufgenommen werden und 
anhand dieser Messmerkmale (4) in einer Bildverarbeitungseinrichtung die Lage 
des Objekts (1) in dem Raum-Koordinatensystem (5) bestimmt wird, dadurch 
gekennzeichnet, dass mindestens zwei Messmerkmale (4) des Objekts (1) in 
einer Aufnahmeeinrichtung (3) gleichzeitig erfasst und zur Bestimmung der Lage 
des Objekts (1) herangezogen werden. 

2 Verfahren nach Anspruch 1 , dadurch gekennzeichnet, dass mindestens 
drei Messmerkmale (4) aus mindestens einem aufgenommenen Bild ausgewer- 
tet werden. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass es 
sich bei den Messmerkmalen (4) urn ausgezeichnete Punkte handelt. 

4 Verfahren nach einem der vorhergehenden Anspriiche, dadurch ge- 
kennzeichnet, dass mehrere Aufnahmeeinrichtungen (3) verwendet werden. 

5. Verfahren nach Anspruch, dadurch gekennzeichnet, dass ein Mess- 
merkmal (4) in mehreren Aufnahmeeinrichtungen (3) abgebildet wird. 

6. Verfahren nach einem der vorhergehenden Anspruche, dadurch ge- 

t, dass eine stationare und/oder eine bewegbare Aufnahmeeinrich- 



tung (3) verwendet wird. 
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7. Verfahren nach Anspruch 6, dadurch gekennzeichnet, dass fur eine 
bewegbare Aufnahmeeinrichtung (3) nach einer Bewegung die Lage der Auf- 
nahmeeinrichtung (3) in dem Raum-Koordinatensystem (5) bestimmt wird. 

8. Verfahren nach einem der vorhergehenden Anspriiche, dadurch ge- 
kennzeichnet, dass die Aufnahmeeinrichtung (3) derart positioniert wird, dass 
zwischen in die Aufnahmeeinrichtung (3) fallenden Sehstrahlen (7), welche von 
verschiedenen Messmerkmalen (4) ausgehen und zur Bestimmung der Lage 
des Objekts (1) herangezogen werden, jeweils ein grofier Zwischenwinkel be- 

steht. 

9. Verfahren nach Anspruch 8, dadurch gekennzeichnet, dass der Zwi- 
schenwinkel zwischen etwa 10° und etwa 170° liegt. 

10. Verfahren nach Anspruch 8 oder 9, dadurch gekennzeichnet, dass die 
Aufnahmeeinrichtung (3) derart positioniert und/oder eingerichtet wird, dass je- 
weils ein moglichst grolier Zwischenwinkel besteht. 

11. Verfahren nach einem der vorhergehenden Anspriiche, dadurch ge- 
kennzeichnet, dass vor Anwendung des Verfahrens die Koordinaten der 
Messmerkmale (4) in einem Objekt-Koordinatensystem (6) erlernt werden, In- 
dem das Objekt (1) in mehreren bekannten Lagen durch die Aufnahmeeinrich- 
tung (3) aufgenommen wird. 

12. Verfahren nach einem der vorhergehenden Anspriiche, dadurch ge- 
kennzeichnet, dass die Auswahl der von einer Aufnahmeeinrichtung (3) zu 
erfassenden Messmerkmale, die Position der Aufnahmeeinrichtung (3) und/oder 
die Brennweite der Aufnahmeeinrichtung (3) selbsttatig bestimmt werden. 
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Zusammenfassung: 

Verfahren zur Bestimmung der Lage eines Objekts im Raum 

Es wird ein Verfahren zur Bestimmung der Lage eines Objekts im Raum (1) be- 
schrieben, bei dem Messmerkmale (4) des Objekts (1) mit einer auf ein Raum- 
Koordinatensystem (5) kalibrierten optischen Aufnahmeeinrichtung (3) aufge- 
nommen werden und anhand dieser Messmerkmale (4) in einer Bildverarbei- 
tungseinrichtung die Lage des Objekts (1) in dem Raum-Koordinatensystem (5) 
bestimmt wird. Urn eine zuverlassige Ermittlung der Lage auch mit wenigen 
Aufnahmeeinrichtungen zu ermoglichen, ist vorgesehen, dass mindestens zwei 
Messmerkmale (4) des Objekts (1 ) in einer Aufnahmeeinrichtung (3) gleichzeitig 
erfasst und zur Bestimmung der Lage des Objekts (1) herangezogen werden. 
(Fig. 1) 
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